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ABSTRACT 


The feasibility of controlling a robot manipulator in minimum time with an 
adaptive computer simulation model is investigated. Updating of model parameters; 
position, velocity and motor gain constant are accomplished from motor position only 
therebv eliminating the requirement for a tachometer. The interactive nonlinear 
dvnamucs of the svstem such as Coupling inertia, Centripetal forces, Actuator dynamics 
and Gravity effects are also investigated. A two link robot manipulator is chosen as 


the simulation model. 
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L INTRODUCTION 


In motion execution of a robot arm, one basic problem is to design a control 
system. This problem is complicated because the dynamic motion of a manipulator is 
strongly influenced by mechanical design and physical properties of the manipulator, as 
well as environmental effects. Coupling inertia, joint friction, coriolis forces, centripetal 
forces, actuator dynamics and gravity effects are considered among these factors. 
These factors produce an interactive nonlinear dynamic system. Under these 
circumstances a robust and flexible control system is needed. 

The curve following scheme is used in all high performance disk files as part of 
the read, write head positioning servo. It has been shown [Ref. 1] that the entire loop 
can be modelled in a computer or microprocessor and the model can be used to drive a 
motor. Algorithms were developed to adapt the computer model for small parameter 
discrepancies and to update the states in the computer. In the robot arm there will be 
large parameter variations in. mass and moment of inertia due to loading and the 
nonlinear dynamics of the manipulator. 

The purpose of this thesis is to investigate the possibility of using the Curve 
Following Velocity Loop Servo to obtain near minimum time positioning of a robot 
manipulator. In this study, a two link robot manipulator with two degrees of freedom 
is chosen as the simulation model. The same control scheme is used to drive both 
motors. 

Figure 1.1 is a simplified block diagram of the control scheme to be investigated. 
The second order model is a simple approximation of the actuator. A Velocity 
feedback loop is used in the adaptive model only. The “Adaptive Algorithm” uses 
Actuator position output to calculate the Actuator velocity, and updates the second 
order model gain constant, position and velocity at certain time intervals. Therefore 
the requirement for a tachometer is eliminated. The “Curve” approximates the 
deceleration curve of an ideal motor. It is chosen as a parabola. The “Environment” 
represents Gravitational torques, Centripetal forces, Coriolis forces and Inertia loading. 
The “Actuator” includes the servo motor and load. Both the second order model and 


the actuator are driven by the same velocity error input. 
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Figure 1.1 Simplified Block Diagram of the Svstem. 


Development of the computer simulation model is presented in Chapter II. 
Chapter III discusses the modelling of the robot arm. The computer adaptive model is 
Heerden Chapter IV. Simulation studies are planned in Chapter V. Simulations 
under different conditions for a Voltage Source Drive System are studied in Chapter 
apre VII discusses the development of a Current Source Drive System and 
presents simulation studies under different conditions. Conclusions and further studv 
areas are presented in Chapter VIII. DSL simulation programs and derivation of 


mathematical model for robot arm are given in Appendixes À — F. 


II. DEVELOPMENT'OF THE COMPUTER SITUPS ION MODEI 


A. INTRODUCTION 


It can be shown [Ref. 2] that the equivalent transfer function of the servo motor 


= nk ON 99797 (eqn Zar) 


where parameters 9, V, I D J, R. and L are defined in ))۶ 7 3 ٥١ 
robot is a large inertia, and when this is added to the motor inertia the mechanical pole 
of the motor becomes smaller. Since ROL is normally a large number. the electrical 
pole of the motor may be neglected and the transfer function of the robot arm and 


motor becomes approximatelv 


Os) ~ RA | 
= I 22 





Figure 2.1 shows the second order model with a curve following velocity loop. 
Ihe Curve used is the deceleration curve for the idealized motor. Bang-Bang control is 
chosen to drive the system with full power. [Ref. 5] 

For a given step position command, the error signal (E) will produce a velocity 
command input. This signal saturates the amplifier and drives the system into full 
acceleration. When the commanded velocitv signal (X) becomes equal to the velocity 
feedback signal (KP) the svstem changes into curve following mode and follows the 


curve until the desired position is reached. 


B. OBTAINING THE CURVE AND MODEL PARAMETERS 

Selection of the curve must be done in such a way that the system will be able to 
follow the curve under different loading conditions. Since a parabolic curve 
approximates the deceleration curve of an ideal motor, it was chosen as the curve to be 


followed. 
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Figure 2.1 Block Diagram of the Model. 


In the robot arm, simulation studies show that the curve must be shaped due to 


the mechanical design of the arm, actuator parameters and gravity effects. 6 


the gain constant (Kl) is used to reshape the curve. In our case Kl was set to a value 


of 0.6. It has been shown [Ref. 1] that the equation of the curve was derived from the 


idealized motor equations as follows: 


°° 


C = m Vsat (eqn 2.3) 
C = j C dt = K. Vsat t + C(0), (C(0)=0) (eqn 2.4) 
EN cus 1/2(K_, Vsat 17) د‎ (eqn 2.5) 


When we solve Equation 2.4 for t and substitude into Equation 2.5, 


C2 
20" Vsat 


For deceleration from initial conditions with the input R = 0, 


C= —E (Cameo 


CEE (¿qu ZE) 


finally when we substitude Equation 2.7 and 2.8 into Equation 2.6 we come up with: 
. X سس ہچ‎ ٣٦٣ JE = commanded velocity 
The second order model gain constant (K,,) is determined by the actuator 
parameters and the effective inertia seen by the actuator. The values of K,, were given 
below (to be derived in Chapter IV. 
° K 0.17 rad/volt 
e. A 1 + + ۱ ۱۳ 


The saturation limits of the amplifiers are determined bv available servo motor 


lI 


ml 


parameters, mechanical design of the arm, working conditions and curve constant (K 1). 
In this studv, the same servo motor is used for both actuators, whether or not gravity 


loading exists. The values of Vsat are: 


lI 


e Vsatl 


150 volts, Vsat2 = 50 volts (gravitv-free environment) 


ll 
II 


e Vsatl = 300 volts, Vsat2 = 150 volts (with gravity loading) 

The gain parameter (K2) of the saturation amplifier is chosen to saturate the 
amplifier for small signals so that it acts as a switch to drive the system with full 
forward and reverse drive signals in the curve following mode. Therefore K2 was set to 
the value of 10.000 to guarantee the saturation of the amplifier. 

The gain of the velocity feedback channel (K) has been given [Ref. 1] K = Kl. 
In hardware realization of the system the value of K can be adjusted to compare the 
commanded velocity signal and the velocity feedback signal. For our purpose 


simulation studies show the best curve following is achieved for K = 1. 


C. SIMULATION STUDIES OF THE MODEL 

The model was simulated using DSL'VS. The DSL simulation program is listed 
in Appendix A. Vsat and K,, were set to 150 volts, 4.0 rad.volt respectively for these 
studies. Figure 2.2 slows phase plane trajectories (Angular velocity P versus angular 
position P) for a step position command of | radian. The figure shows that the model 
angular velocity increases with constant acceleration until the curve is reached. Then 
the voltage applied to the model reverses and the model velocity follows the curve until 
the desired angular position is reached. The step response of the model is shown in 


Figure 2.3. 
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HI. MODELLING THE ROBOT ARM 


A. INTRODUCTION 

In this chapter, a mathematical model of a two-degrees-of-freedom planar robot 
arm 1s developed using lagrangian mechanics. The dynamics equations relate torques 
and forces to positions, velocities and accelerations. We need dynamics equations to 
get the equations of motion of the manipulator. We need to know the relationship 
between torque and acceleration at a joint, and the relationship between torque at one 
joint and acceleration at other joints. We also need to know effects of the gravity 
torques and velocity dependent torques. Velocitv dependent torques are tvpicallv small 
compared to other system torques. They are important when the manipulator is 


moving at high speed. 


Do MODEL DEVELOPMENT 

The two-degrees-of-freedom planar robot arm considered is illustrated in Figure 
3.1. The motion of the robot arm is constrained to the xy plane. Both joints are 
rotary joints. There are two links, connecting the two joints and a terminal grasping 
device at JOINT2 with or without load. It is assumed that the links are massless and 
two equivalent masses are lumped at the end of LINKI and LINK2. The lengths of 
BER) and LINK2 are denoted di, d, and two masses are denoted m,, m, 


respectively. T,, T, represents the external driving torques to the joints. 


C. DERIVATION OF EQUATION OF MOTION 
The lagrangian L is defined as the difference between the kinetic energy K and 


EBUSlenersveV of the system L= K — V‏ | للا 


Equation 3.1 defines the Lagrange's Equation 


d OL CL 
| —= FE j=1,...,n (andan 
dt 09; 


where 
q; = generalized coordinates 
q; = corresponding velocity 


F. = the corresponding force or torque 
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Figure 3.1 Point Mass Representation of a Two-Degrees-Of-Freedom 
0 planar Robot Arm. 
L = Langrangian of the system 
n = number of degrees of freedom 
To apply equation 3.1 to the robot arm, the rotation angles 0, and 0, are chosen 
as the generalized coordinates. The generalized forces F,, F, would be the total 
torques about the axis of rotation of 8, and 8, The detailed derivation is presented in 
Appendix B. The following pair of second-order nonlinear differential equations has 


been derived and will be used as the basic mathematical model for this thesis. 


(Dj, * J4,5)0, 9 T4 — (Dj58, -- D51,81^ + Go) (eqn 3.3) 
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where 
D¡¡ 77 e == modo? + 20001 0, 
[ss m»ds? * modjd5cos6, 
moo c 7 
Dj557 7 mydyd>sinó> 
ا‎ 252 = Py 
D51,;= m5d,d5sin8, 
Gi ١0 £ mod»cos(0 - 8 
G> = məd>əcos(9 - 98 


J = motor inertia for Joint I motor 


ml 

motor inertia for Joint 2 motor‏ = کل 
5 | 3 

mu = 0.235 07 10, 5ec” 
8 D 

m> = 0.041 oz in; sec” 


My = 0.082 oz;in;sec” (with load) 
dj = 15 inches 
də = 10 inches 


3 : 2 
336.4 imisec 


ga 
II 


ete Equattons 3.2 and 3.3 in the form‏ ا اننا 


i 21992 
E 
+ روه‎ 0, 


‘In these equations (D¡¡+3,,1) and (D>>+J,,>) are known as the effective 
inertia at joints 1 and 2. Accelerations at these joints cause torques and are referred to 
as inertial torques. Dj» is known as the coupling enertüa between JOIMII and 
JOP ` [2. D 56^ is the reaction torque acting on JOINTI induced bv the angular 
acceleration of JOINT2; D 58, Is the reaction torque acting on JOINT2 induced by 


angular acceleration of JOINII. D 3985? is the centripetal force acting on JOINT] 
generated by the angular velocity of JOINT2: PN 15 the centripetal force acting 
on JOINT? due to angular velocity at JOINTI. D,,50,05 + D,5/8,05 is the coriolis 
force acting on JOINTI generated by the angular velocities of both JOINTI and 


JOINT2. Gj and Gj represent the gravity forces on JOINTI and JOINT2 


respectively. [Ref. 4] 


IV. THE COMPUTER ADAPTIVE MODEL 


A. INTRODUCTION 

The second order model of Chapter II is to be used to drive, open loop. the servo 
motor of one joint of the robot arm. The servo motor has to follow a predetermined 
curve until a desired position is reached. To accomplish this, the second order model 
states and gain constant have to be adapted in such a way, that the model mimics the 
position and velocity and has a gain constant equivalent to that of the actual servo 
motor. In this chapter we will first discuss the selection of servo motors for testing of 
the adaptive systems and will then obtain the algorithm to update the second order 
model position. velocity and gain constant. The calculation of the initial value of the 


model gain constant (A) is also given in this Chapter. 


PEE ELECTION OF THE SERYO MOTORS 
A permanent magnet motor drive currently used in industrial robots was selected 


tomesmine adaptive svstem. Parametric data for the motor are listed in Table 1.[Ref. 3] 


TABLE 1 
PARAMETRIC DATA FOR JOINT SERVO MOTORS 


Torque Constant Ky 14. 4 oz-in/amp 


MOSS oz-in-sec^/rad‏ ا 


Damping Coefficient B, 0. 04297 oz-in-sec/rad 
Back emf Const. SK, O. 1012  volts-sec/rad 
Armature Inductance L 100 i-henries 


Ave. Terminal Resistance R 051 ohms 





The same motor drive is used for both JOINT1 and JOINT2 with a different 
power supply. To calculate the transfer functions of the servo motors, we need to 


know the effective joint inertias: 


eee 21] 7 “mi 


tv 
LJ 


* JEFF Dome 
Where Dae Dos. J 1 ٢ are given in Chapter II. When we substitute parameters, 


we come up with: 


me 


© JEEFI = 91.425 oz.in.s7 (for 9, = 0?) 
9 IEEE = 4.14 oz.in.s? 
Substituting effective inertias calculated above and parameters given in Table 1 into 


Equation 2.1, gives us the transfer functions of the servo motors. 


9.88 
Gl(s) 9» —————————————— radians; volts (eqn 4.1) 
S S ۷۰ 
| 9.88 ۱ 
GAS) سی کے‎ La olts (eqn 4.2) 


S(S:9100+ 1)(S.0.39 + 1) 


The Open Loop Bode plots for the servo motors are shown in Figures 4.1 and 
4.2. From the Open Loop Bode plots it can be observed that the - 40dB/decade slope 
crosses the 0.0 dB axis at Q9, —0.412 rad/sec and Q»^- 2.0 rad/sec for JOINTI and 
JOINT2 servo motors respectively. When we use the (0, and œ, frequencies as the 
gain crossover frequencies of the second-order ideal motors, we come up with: 
ه‎ K = 0.17 rad/volt 
s Ro +7٣٤ 


Thus the gain constants Km, and Kyo of the second-order models were set 


ml 


initially to these calculated values to determine the curve derived in Chapter I]. Open 


. v . ° . 
Loop Bode diagrams of the K,,/s” ideal motors are given in Figures 4.3 and 4.4. 


C. OBTAINING THE ADAPTIVE ALGORITHM 

Figure 4.5 shows block diagram of the adaptive system for a joint servo drive. 
The same adaptive scheme is used to drive both servo motors separately. In this 
diagram Ty refers to the sum of disturbance torques such as Centripetal Torques, 
Centrifugal Torques, Reaction Torques and Gravitational Torques. The saturation 
amplifier output signal is common input to both the second-order model and servo 
motor. Output of the servo motor is measured and fed into the Adaptive Algorithm 
block. Our next step will be to Calculate am estimate ٤ +91 0 
parameter (Kin) and the velocity of the servo motor. In these calculations, two criteria 


must be taken into consideration: 
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Figure 4.1 Open Loop Bode Plot of the JOINTI Servo Motor. 
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Figure 4.2 Open Loop Bode Plot of the JOINT? Servo Motor. 
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ptive Joint Drive System. 
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Figure 4.5 Block Diagram of the Ada 


V. PLANNING THE SIMULATION STUDIES 


A set of sample motions was selected to serve as a basis for simulation studies of 
the system. The sample motions were designed to remove as many of the 
nonlinearities as possible and to investigate the system behavior for possible 
overloading conditions. The set of sample motions used are depicted in Figures 5.1, 5.2 
and 5.3. 

Simulation studies were done for two different drive systems. These were: 

e Voltage Source Drive 


e Current Source Drive 


Each drive system was tested separatelv for: 
e  Gravity-Free Environment 
e With Gravity Loading 


Position Command inputs to the system were: 
e Step Input 


o Time Varving Input 


In this thesis, a free work space is assumed for the robot arm. To find the 
munimum time response for a given step position command, a step input was applied to 
the servo motors: 

e At the same time 


e At different times 


All simulation studies are planned for both loaded and unloaded robot arms. 


E 


e. [he calculations must be accurate enough to allow the second-order model 
states to approximate the trajectory of the servo motor. 


e. The calculations must be kept simple to update the second-order model states 
and gain constant in nunimum time. 


There are several means of doing these calculations. For our purpose. the 
method described in [Ref. 1] best satisfies the criterion given above. It can be shown 
[Ref. 1] that; when we solve Equation 2.5 for BS 

$ 


pm 
kK. = ——-. z C eqn 4.3 
m Vsatt o 


For discrete time intervals and letting P = PM, 


1 2PM 


K = ——— eqn 4.4 
e STONED د‎ 


Where I is the sampling period and N is the number of sampling intervals. Equation 
4.4 1s valid only for constant acceleration of the servo motor. Therefore the value of 
K,4 1$ updated during the full acceleration of the servo motor, then remains unchanged 
for the curve following portion. 


The estimation of the angular velocitv of the servo motor has been given [Ref. 1] 


PM(N) = 2IPM(N) - PMEN - DIT — PM(N- 1) (eqn 4.5) 


PM(N- 1) = [PM(N) - PM(N - 2)21 (eqn 4.6) 


Equation 4.5 requires the storage of the last sample position of the servo motor 
[PM(N — 1)] and the last estimated angular velocity IPMN = D). Ihe stored value of 
PM(N — 1) can be recalculated after 2 samples of position are taken. If the second- 
order model switches from full acceleration to curve following between samples of 
position. Equation 4.5 is not self-correcting until two position samples can be taken 
after switching. To take care of the deficiency, the switching time is detected and the 
present value of the second-order model velocity is stored as PM(N — 1) to be used in 


the next calculation. 


FINAL POSITION 
PMi= 1 radian 
PM2= | radiani 


INITIAL POSITION 
BML(0)= O radian 
PM2(0)= O radian 





Figure | Sample Vione 1: 


52 









INITIAL POSITION 
EMO) 1.5 radian 
PM2(0)= 0 radian 


FINAL POSITION 
PMi= O radian 
PM2=-1.5 radian 


Figures 2 Sample Move 72. 
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INITIAL POSITION 
PM1(0)= O radian 
PM2(0)= O radian 





FINAL POSITION 
PM1=-1.5 radian 
PM2= 1.5 radian 





Figure 5.3 5۶۰ 


01 OE TAGE SOURCE DRIVE SYSTEM 


A. INTRODUCTION 

The computer adaptive system with voltage source drive was developed in 
Chapter IV. Figure 4.5 illustrates the block diagram of the adaptive system with 
voltage source drive. The DSL/VS simulation program used in the testing of the 
adapuve system with Voltage Source Drive, is listed in Appendix C. Both adaptive 
models with servo motors are simulated at the same time in the program to assure 
realistic interaction between joint servo motors. 

A sample region was added to obtain the servo motor angular positions at 
٠۰۰۰٠٠٠٠٠٠٠٦٠٦ intervals PAIN), The DELS parameter of the DSL WS simulation 
program allows the simulation to enter the sample region every T = 9.25 milliseconds. 
The adaptive algorithm, also included in the sample region, calculates the estimates of 
servo motor angular velocity (PM) and the second-order model gain parameter (Kin) 
from the sample of the servo motor angular position. At every sampling time. the 
second-order model states P, P are reset with the values of the servo motor position 
and velocity PM, PM and the model gain parameter K,, is updated during the full 
acceleration part. Fixed step integration was used in the simulation to support easy 
hardware implementation. The integration interval was chosen to be 1,5 the sampling 


period. 


B. SIMULATION STUDIES OF THE ADAPTIVE SYSTEM 
Appendix C and D list the DSL. VS simulation programs used in testing the 
adaptive system. The simulation program for the gravity-free environment is included 
in Appendix C. The simulation program in Appendix D includes gravitational torques. 
1. Gravity-free Environment 
The adaptive system without gravitational torques is tested for both step 
position command and time varying position command inputs. Note that on all phase 
plane plots the velocity of the second-order model and the velocity of the servo motor 
are both plotted as ordinates. In general these curves fall on top of each other. Move 
=l and Move +2 are used in this part of the simulation studies. The following results 


are observed: 


tos 
ما‎ 


a. Step Position Command Input Used 

Figures 6.1 and 6.2 are the phase plane plot and step response curves for 
the unloaded arm. In the phase plane plot, the second-order angular velocity P and 
the servo motor angular velocity PM are plotted versus servo motor angular position 
PM. Although PM cannot be observed in the actual system, it is available in the 
simulation and is used to check the validity of the algorithm. 

Figure 6.1 shows that the second-order model and servo motor have good 
curve following characteristics for both joints. The step response curves of Figure 6.2 
show the models and servo motors tracking together. Steady state accuracy of the 
order of 1OE-4 is observed. The loaded arm was simulated in Figures 6.3 and 6.4 In 
these figures, effects of the reaction torques can be observed. At the beginning of the 
move, upward motion of the LINK2 creates an interaction torque on JOINT! servo 
motor. Therefore it takes time to overcome the reaction torque 11 ٢ ٠٥ 
accelerating. To avoid this unwanted situation, the .position command for JOINT2 
servo motor is delayed 150 millisecond at the beginning of the move. This is shown in 
Figures 6.5 - 6.8. 

The effects of the delaved input for phase plane trajectories can be 
observed in Figures 6.5 and 6.7. When JOINT2 servo motor starts accelerating, the 
reaction torque causes JOINTI servo motor to decelerate for a while. Meanwhile, 
curve following seems lost but after a while the adaptive system tracks and follows the 
curve until the desired position is reached. Faster over-all response was obtained with 
this strategy also. 

Simulation studies for Move +2 are shown in Figures 6.9 - 6.16. Figures 
6.9 and 6.11 are good illustrations to point out the importance of the reaction torques 
between joints. Interactive torques gain more importance when servo motors operate 
in opposite directions. In these figures it can be observed, acceleration of the JOINT2 
servo motor helps JOINTI servo motor to speed up quickly. When JOINT2 servo 
motor reaches the curve and starts deceleration, the interaction torque created bv 
JOINT2 servo motor opposes JOINTI servo motor acceleration. Maximum angular 
velocity of 3.7 rad/sec and 13.4 rad/sec are observed for motors 1 and 2 respectively. 
Step response curves Of Wlove ۱ ٢٢٦٦٦ ٠ 

The adaptive svstem was also simulated for a different input sequence, ie 
JOINT2 servo motor position command delaved at 0.15 second. The effects of the 


delaved input can be observed in phase plane plots of Figures 6.13 and 6.15. 
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Figure 6.10 Step Response For Move #2 (No Gravity). 
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At the beginning of Move Z2 JOINTI servo motor moves slower while the 
other servo motor stands still After JOINT2 servo motor starts accelerating. 
appreciable speed-up can be observed in the first servo motor phase plane trajectory. 
This speed-up results in passing over the curve a little. After a while the system tracks 
the curve and follows it until the position is reached. Step response curves in Figures 
6.14 and 6.16 show 40 milliseconds slower response time in comparison to the 
simulation results obtained when simultaneous inputs are applied. 

b. Time Varying Position Command Input Used 

To simulate the adaptive system under time varying command. a ramp 
input with tangent of | rad/sec and sinusoidal input are used. Simulation results are 
shown in Figures 6.17 - 6.28. Phase plane trajectories for ramp input are shown in 
Figures 6.17 and 6.20. Good curve following is observed in the figures. JOINT? servo 
motor velocity builds up and becomes closer to steady-state velocity in a short time 
interval. JOINII servo motor velocity can't build up as fast as the second servo 
motor because of large inertial and interaction torques. Therefore JOINTI servo 
motor follows the ramp input with larger errors. Figures 6.19 and 6.22 show position 
error for servo motors. Phase plane trajectories for sinusoidal input are shown in 
Figures 6.23 and 6.26. Good curve following is seen in these figures. JOINT2 servo 
motor follows the given input command easily with small errors but JOINTI servo 
motor lags behind the sine input curve because of the reasons mentioned above in the 
case of a ramp input. Position error between commanded position input and actual 
servo motor position output is given in Figures 6.25 and 6.28. 

Simulation studies show that the magnitude of the position error depends 
on the sinusoidal position command input magnitude and frequency. The smaller the 
frequency, the smaller the position error that is obtained. For a fixed frequency, the 
smaller magnitude of input gives a smaller position error. 

2. Gravitational Torques Included 
The adaptive system was simulated under gravitational torques. Moves #1, =2 
and #3 were used to test the system for the existence of excess interactive torques. 
Both step input and time varving input were used in the simulation studies. 
d. Step Position Command Input is Used 

Figures 6.29 - 6.32 are the phase plane plots and step response curves for 

simultaneously applied step position input commands. Phase plane trajectories show 


that JOINTI servo motor develops negative velocity (in the opposite direction of the 
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Figure 6.24 Sine Response (No Gravity). 
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Figure 6.27 Sine Response (No Gravity - Loaded Arm). 
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move) at the beginning of the motion. This negative velocity is caused bv gravitational 
torques and interactive torques in the system. It can be observed that gravitational 
torques are at the maximum value when servo motors start moving. After JOINTI 
servo motor torque overcomes the disturbance torques. the servo motor starts 
accelerating in the direction of the move, catches and follows the curve until the final 
position is reached. 

In the case of a loaded arm, a larger magnitude of negative velocity is seen 
because of greater gravitational torques. Step response curves are shown in Figures 
6.30 and 6.32. It can be observed that the negative velocity at the Dei me o. cine 
move resulted in JOINTI servo motor moving in the wrong direction initially. One 
might think that the situation at the beginning of the move mav bring problems in 
some applications. To avoid this situation. JOINT? servo motor position command 
was delaved 0.1 second at the beginning. Simulation results are shown in Figures 6.55 
- 6.36. Phase plane trajectories snow that the negative velocity at the beginning of the 
move is lost. A zig-zag shape in JOINTI servo motor phase trajectory is seen due to 
reaction torque produced by JOINT? servo motor. The same overall time response 
was obtained. 

Simulation studies with Move =2 are shown in Figures 6.37 - 6.40. It can 
be seen that both second-order model and servo motor have good curve following 
capabilities and they are on top of each other. Maximum velocities of 6.6 rad. secand 
22 rad sec are seen for servo motors | and 2 respectively. Im this SALE ae E 
reaction torques increase the servo motor acceleration until the curve is reached. After 
that, reaction torques oppose the servo motor deceleration along the curve. As a 
result, acceleration time of the move 1s shorter than deceleration time. Step response 
curves are shown in Figures 6.38 and 6.40. 

Move #3 was used lor extensive testing of the system. Phase plane 
trajectories are shown in Figures 6.41 and 6.45. [t can be seen at the beginning of the 
move, When servo motors start accelerating, the reaction torque produced by JOINT? 
servo motor keeps JOINT1 servo motor from accelerating, even causing it to move in 
the opposite direction to the motion. This situation is clearer in the step response 
curves of Figures 6.42 and 6.44. To avoid the unwanted effects of the reaction torques 
at the beginning of the motion, step position command input to the second servo 
motor was delayed 100 milliseconds. Simulation results are shown in Figures 6.45 - 
0.45. For the unloaded arm. a different input sequence worked out well. From the 


phase plane plot (Figure 6.45) good curve following can be seen. 
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Figure 6351 Phase Plane Trajectory For Move #1 (With Gravitv). 
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Figure 6.31 Phase Plane Trajectory For Move #3 (With Gravity). 
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Figure 6.42 Step Response For Move #3 (With Gravity). 
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It 1s also noticed that when JOINT2 servo motor starts accelerating, the 
reaction torque produced causes the JOINTI servo motor velocity to go down for a 
while, resulting in passing over the curve and staving there for a certain amount of 
time before 1t catches up and follows the curve until the desired position is reached. 
From the step response curve (Figure 6.46), 60 milliseconds faster overall response is 
observed. 

Phase plane plots and step response curves for Loaded arm with different 
input sequences are shown in Figures 6.47 and 6.48. Delayed (100 milliseconds) step 
position input for JOINT2 servo motor causes JOINT1 servo motor to overshoot. 
This result implies the importance of the effects of the inertial torques and interaction 
torques on the loaded arm. 

b. Time Varying Position Command Input Used 

Ramp input with tangent of | rad sec and a sinusoidal input were used to 
test the adaptive svstem under gravitational torques. Simulation results are shown in 
Figures 6.49 - 6.60. Phase plane trajectories of Figures 6.49 and 6.52 show second- 
order model and servo motor velocities are oscillating around the curve. From Figures 
6.50 and 6.53, it is seen that JOINT2 servo motor follows the ramp input with very 
small errors, while JOINT1 servo motor is lagging behind the ramp input with larger 
errors. Figures 6.51 and 6.54 show errors between commanded position input and 
actual position of the servo motors. It can be observed, that the error tends to go to 
zero very slowly. 

Simulation studies with sinusoidal input under gravitational torques are 
shown in Figures 6.55 - 6.60. Good curve following is observed from phase plane 
trajectories. Sine response curves in Figures 6.56 and 6.59, show the second-order 
models and servo motors follow the time varying position command with small errors. 


The error between desired and actual position is shown in Figures 6.57 and 6.60. 
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Figure . Phase Plane Trajectory For Move £3 (With Gravity) 
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Figure 6.49 Phase Plane Trajectory For Ramp Input (With Gravity). 
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Figure 6.53 Ramp Response (With Gravity - Loaded Arm). 
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Figure 6.56 Sine Response (With Gravity). 


25 





160 
140 
420 
100 
40 
0.0 0. 4 0.8 1.2 1.5 2.0 
TIME (SECONDS) 


ERROR VS TIME (VOLTAGE SOUR. DRV.) 


Figure 6.57 Error Between Commanded and Actual Position 
(With Gravity). 


96 


169 


149 


120 


100 


PHADT (RAO/SEC)__ 


POT (RAO/SEC) _ 


4. .0 0.4 0.8 
-0 0.7 0.9 


0. 0.5 
PM1 (RAD) 


PHASE PLANE (VOLTAGE SOUR. ORV. WITH LOAD) 


Figure 6.58 Phase Plane Trajectory For Sinusoidal Input 
(With Gravity - Loaded Arm). 


P 


2 -0.8 -0.4 0 
PM2 (RAD) 
1 0.1 5 


1.2 


1.1 





6 
3 
0 
3 


„E 


Pre (RAO) _ X 





-4. 
0.0 0.4 0.8 1.2 1.8 2.9 
a TIME (SECONDS) 
1.0 
| 0. 
E 0.0 
0.0 0.4 1.5 2.0 


0.8 E i 
TIME (SECONDS) 
SINE RESPONSE (VOLTAGE SOUR. ORV. WITH LOAD) 


Figure 6.59 Sine Response (With Gravity - Loaded Arm). 
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VII. THE CURRENT SOURCE DRIVES EM 


A. DEVELOPMENT OF THE CURRENT SOURCE DRIE SYS MRP 

In a DC servo motor; to achieve constant acceleration, the armature circuit 
current must build up quickly to a constant value and provide constant torque. This is 
important for the second-order model to control the servo motor. Á current source 
drive system can be used to accomplish this. 

It can be shown [Ref. 2] that the transfer functions for a permanent magnet DC 


servo motor, when the viscous friction of the motor and load is small. are: 





0(s) K 

(eqn 7.1)‏ ات سے سا سال ا n‏ 
MS) SORT‏ 

i i (egn T2) 


Vís)  KR+sL)Js + KK] 


where 
8 = Angular position of the shaft 
V = Applied d-c voltage 
| = Armature current 
y= Back emf constant 
t= Torque constant 


K 
K 
J = Total inerua 
R = Armature resistance 
L = 


Armature inductance 


The transfer function block diagram of a Current Source Mes sho o e 
ال( ,.ءم))‎ 
If the amplifier gain is chosen as such that 


KA > > | ) ٦ 


then the equivalent transfer function of the amplifer can be written as; 
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V _ [R+sL)Js + K.K.] 





= ——=— oo—— mama em | ne o س اوس‎ n 
V, m (eqn 7.4) 
The equivalent transfer function becomes: 
O(s) pen 
E t' M 
| z — — e m 
V. (s) 62 (eqn 7.5) 


Thus if the amplifier gain is carefully chosen. the ideal motor of the second-order 
model will be approximated by the system and the effect of the back emf and armature 
inductance will become negligible. 

Simulation block diagram of the current source drive system is shown in Figure 
7.2. R. was chosen to be 0.1 to mininuze the influence on the electrical pole, inversely 
Ke was set at 10.0. The amplifier gain (KA) and saturation linut (VSATA) were 
chosen by trial and error. These values were found: 


3 ارام‎ ara rational و‎ 


A1= 150, VSATA1= 10 
KA2=75, VSATA2= 50 
° Gravitational t torques are included 
KA1 = 350, VSATAL = 300 
KAŻ = 175, VSATA2 = 150 
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Figure 7.1 Transfer Function Block Diagram of 
the Current Source Drive. 
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B. SIMULATION STUDIES OF THE ADAPTIVE SYSTEM. 

DSL/VS simulation programs used in simulation of the adaptive system with 
Current Source Drive are listed in Appendix E and F. The simulation program listed 
in Appendix E is used for studies under a gravity-free environment. Appendix F lists 
the simulation program which includes gravitational torques. Again note that although 
PM cannot be observed in the actual svstem, it 1s available in the simulation and is 
used to check the validity of the algorithm. 

l. Gravity-Free Environment ۱ 

Step position command and time varving position command inputs are used 
to test the adaptive system under a gravity-free environment (No Gravitional Torques). 
Sample motions, Move #1 and Move #2 are used in the simulation studies of this part. 
Note that on all figures of Phase Plane Trajectories the angular velocitv of the second- 
order model (P) and the angular velocity of the servo motor (PM) are both plotted as 
ordinates. The second-order model angular position (P) and the servo motor angular 
position (PM) are both plotted as ordinates in the time response plots. In general 
) curves fall on top of each other. 

a. Step Position Command Input Used 

Phase plane plot and step response curves for the unloaded arm under 
Move #1 are shown in Figures 7.3 and 7.4. In the phase plane plot PM and P are 
plotted versus PM. The step response curve shows P and PM are plotted versus time. 
Good curve following characteristics are seen in Figure 7.3. Maximum 
angular velocity of 3.17 rad;sec and 12 rad;sec are observed for servo motors 1 and 2 
respectively. The step response curves of Figure 7.4 show the second-order models and 
servo motors tracking together. Also much faster time response was observed for 
JOINT? servo motor due to smaller inertia and supporting reaction torques in the 
direction of motion. Steady state accuracy of the order of 10E-4 is observed. 
- The simulation results for the loaded arm are shown in Figures 7.5 and 7.6. 
The effects of the reaction torques can be observed in these figures. At the beginning 
of the move, upward motion of the LINK2 produces an interaction torque on JOIN HI 
servo motor. This reaction torque opposes JOINTI servo motor acceleration in the 
direction of motion. Therefore it takes some time to overcome the reaction torque, 
and LINKI starts accelerating. To avoid this situation, JOINT2 servo motor position 
command input is delayed 150 milliseconds at the beginning of the Move zl. 


Simulation results are shown in Figures 7.7 - 7.10. 
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The effects of the delayed JOINT2 servo motor can be observed in the 
phase plane trajectories of Figures 7.7 and 7.9. At the beginning, JOINTI servo motor 
starts accelerating while JOINT2 servo motor stavs still. When JOINT? servo motor 
starts accelerating. the reaction torque produced bv JOINT? servo motor causes 
JOINTI servo motor to decelerate for a while. Meanwhile, curve following seems lost, 
but after a while the adaptive svstem tracks and follows the curve until the final 
position. [n the loaded arm case, 7% overshoot was observed for JOINT2 servo 
motor. This can be prevented by lowering the curve gain constant. Faster overall 
response was obtained with delayed input. | 

Figures 7.11 - 7.18 show simulation results for Move #2. Figures 7.11 and 
7.13 are good examples to show the effects of the interaction torques on the servo 
motors. At the beginning of the move, the reaction torques produced by accelerations 
of the servo motors increase each others acceleration in the direction of the move. 
Therefore, servo motors reach maximum angular velocities in a short time. When 
JOINT? servo motor reaches the curve and starts braking, the interaction torque 
produced bv JOINT?2 servo motor opposes JOINTI servo motor acceleration in the 
direction of the motion. Step response curves of Move 52 are shown in Figures 7712 
and 7.14. It can be observed, in the case of loaded arm, JOINT2 servo motor 
overshoots and undershoots before it reaches the steady-state. This is due to the 
reaction torque created by JOINTI servo motor. 

To take care of this deficiency, JOINT2 servo motor curve gain constant 
was lowered to 0.5. Simulation results are shown in Figures 7.15 - 7.18. Phase plane 
trajectories show that smaller, average velocities are obtained for JOINT2 servo motor 
with a lowered deceleration curve. Good curve following characteristics are observed. 
Step response curves show almost no overshoot but longer time response for JOINT2 
servo motor. This can be thought of as a price to be paid to get no overshoot. But if 
we think over-all time response depends on JOINTI servo motor, then this time 
increase response of JOINT2 servo motor doesn't bring on an additional time increase 
to the system: 

b. Time Varying Position Command Input Used 

The adaptive system under time varying command input was simulated by 
using a ramp input with tangent of | rad/sec and a sinusoidal input. Simulation results 
are shown in Figures 7.19 - 7.30. Phase plane trajectories of Figures 7.19 and 7.22 
show; JOINT2 servo motor velocity builds up quickly and reaches the steady-state 


velocity in a short time. 
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The second-order model and servo motor velocity of JOINT2 shudders 
around the curve until the desired position is reached. Large inertial torques and 
interaction torques prevent JOINTI servo motor velocity to build up as fast as 
JOINT2 servo motor veloticy. It takes more time for JOIN Wi servo monemcloci a. 
reach steady-state velocity. Therefore, JOINTI servo motor follows the ramp input 
with larger errors. Errors between commanded position input and actual position 
output of servo motor are shown in Figures 7.21 and 7.24. 

Phase plane plots of simulation studies for sinusoidal input are shown in 
Figures 7.25 and 7.28. Good curve following capabilities are seen in phase plane 
trajectories. From Figures 7.26 and 7.29, it can be observed that JOINT2 Servo motor 
follows the sinusoidal input easily while JOINT! servo motor lags behind the sine 
input curve. The reasons for this we mentioned above in the case of a ramp input. 
Position errors for servo motors are shown in Figures 7.27 and 7.30. Again simulation 
studies show that the smaller the frequency of the sinusoidal position command input, 
the smaller the position error that is obtained. Also, for a fixed frequency, the smaller 
magnitude of input curve gives a smaller error. 

2. Gravitational Torques Included 

To simulate the adaptive system under gravitational torques, Moves Fl, #2 
and #3 were used. Again note that on all figures of phase plots, the second-order 
model velocity (P) and servo motor velocity (PM) are both plotted as ordinates versus 
servo motor angular position (PM). In time response curves, the second-order model 
angular position (PM) are both plotted as ordinates. In general, these curves fall on 
top of each other. In the simulation studies, both step and time varying position 
command input were used. 

a. Step Position Command Input Used 

Phase plane plots and step response curves for Move #1 are shown in 
Figures 7.31 - 7.34. ۱87009961068۷٣٣٣ ل‎ +١۹۹٣ 
observed that gravitational torques and reaction torque produced by JOINI2 servo 
motor causes JOINTI servo motor to move in the opposite direction of the move. 
Note that gravitational torques are at the maximum value at the beginning of the 
move. It takes a while to overcome the gravitational and reaction torques, after that 
the JOINT1 servo motor stars accelerating until it catches and follows the curve till the 


desired position is reached. 
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The phase plane plot for loaded arm (Figure 7.33) shows that the 
magnitude of the negative velocity was increased for JOINTI servo motor. When 
JOINT? servo motor catches, the curve starts deceleration, JOINT1 servo motor 
velocity starts increasing very rapidly until JOINT2 servo motor reaches the steady- 
state. If we think that the opposite movement of the JOINTI servo motor has to be 
avoided, then a different input sequence may be used to accomplish this. For this 
purpose, JOINT2 servo position command input was delaved 200 milliseconds at the 
beginning. Simulation results are shown in Figures 7.35 and 7.36. From phase plane 
trajectories, it can be observed that JOINT1 servo motor can start accelerating without 
going in the wrong direction while JOINT2 servo motor stands still. A zig-zag shape is 
seen in JOLNTI servo motor trajectory due to the reaction torque prateadas 
JOINT? servo motor after it starts accelerating. Also, from step response MM sure 
7.36). 1090 Overshoot 1s observed for JOINT2 servo motor due to ine 1 7 
produced by JOINTI servo motor. The same overall time response was obtained. 

Simulation results for Move #2 under simultaneous applied inputs, are 
shown in Figures 7.57 - 7.40. Phase plane trajectories (Figure 7.37) show that both 
second-order model and servo motor have good curve following capabilities with 
maximum velocities of 6.5 rad/sec and 27.6 rad/sec for the loaded arm. Figure 7.39 
show that JOINT2 servo motor reaches steady-state after it overshoots twice and 
undershoots once. This is clearer in step response curves of Figures 7.40. A different 
input sequence was used to avoid the JOINT2 servo motor overshoot. Therefore, 
JOINT2 servo motor position command input was delaved 100 milliseconds. The 
purpose of this delay is to nunimize the effect of the reaction torque produced by 
JOINTI servo motor on JOINT2 servo motor. With delayed input JOINT2 servo 
motor reaches steady-state without overshoot, while JOINTI servo motor decelerates. 
This deceleration provides additional braking torque on the JOINT2 servo motor. 
Simulation results are shown in Figures 7.41 - 7.44. The same overall time response 
was obtained. 

Move #3 was used for additional testing of the system under different 
loading conditions. Simulation results are shown in Figures 7.45 - 7.48. Phase plane 
trajectories show that, at the beginning of the move, the reaction torque produced by 
acceleration of JOINT2 servo motor prevents JOINTI servo motor from accelerating 
for a while. On the contrary the reaction torques do not work in favor of the servo 
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motors for Move #3. 
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Figure 7.48 Step Response For Move #3 (With Gravity). 
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From phase plane trajectories 6.9 rad/sec and 21.3 rad sec, maximum 
velocities are seen for servo motors l and 2 respectively. Good curve following 
capabilities for both the second-order model and servo motor are seen and they are on 
top of each cther along the move. 

b. Time Varying Position Command Input Used 

To simulate the adaptive system under gravitational torques, a ramp input 
with a tangent of 1 rad/sec and a sinusoidal input were used. Simulation results are 
shown in Figures 7.49 - 7.60. 

Phase plane trajectories of Figures 7.49 and 7.52 show that at the beginning 
of the move, the second-order model and servo motor velocities increase very rapidly to 
reach the steadv-state value. [t can be observed that this process takes a much shorter 
time for JOINT? servo motor in comparison to JOINTI servo motor. This can be 
mouet to be the result of the reaction produced by JOINT2 servo motor The 
second-order model and servo motor angular velocities snudder around the curve to 
follow it. Ramp response curves of Figures 7.50 and 7.53 show the JOINT? servo 
motor is able to follow the ramp input easily with very small errors. Meanwhile, 
JOINT2 servo motor is lagging behind the ramp input because of the reasons 
mentioned above. Position error between commanded and actual angular position of 
the servo motors are shown in Figures 7.51 and 7.54. In the case of a loaded arm, the 
error reaches its maximum value at the beginning of the move, after that it decreases 
exponentially. 

Figures 7.55 - 7.60 are the simulation results obtained with sinusoidal 
position input. Phase plane plots show that good curve following capabilities are 
observed. More shuddering around the curve is seen for JOINT? servo motor. Sine 
response curves of Figures 7.56 and 7.59 show that both servo motors follow the 
commanded input. The position error between the desired angular position and actual 


servo motor angular position is shown in Figures 7.57 and 7.60. 
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Figure 7.49 Phase Plane Trajectory For Ramp Input (With Gravity). 
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Figure 7.50 Ramp Response (With Gravity). 
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Figure 7.51 Error Between Commanded and Actual Position 
(With Gravity). 
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Figure 7.53 Ramp Response (With Gravity - Loaded Arm). 
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Figure 7.54 Error Between Commanded and Actual Position 
(With Gravity - Loaded Arm). 
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Figure 7.56 Sine Response (With Gravity). 
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Figure 7.58 Phase Plane Trajectory For Sinusoidal Input 
(With Gravity - Loaded Arm). 
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Figure 7.59 Sine Response (With Gravity - Loaded Arm). 
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۷111. CONCLUSIONS /AREAS FORIPUR THER TUDI 


As a result of the simulation studies done in this thesis, the near minimum time 
positioning of a two-link robot manipulator with an adaptive computer model seems 
feasible. Three sample moves were used to remove as many nonlinearities as necessary 
to test the adaptive system under large parameter variations. In these nonlinearities, 
coupling inertia, centripetal forces, actuator dynamics and gravitational torques were 
included. 

As observed, servo motors overshoot for some of the moves. These conditions 
were overcome by offering alternatives such as lowering curve gain constant or using a 
different input sequence. 

In this study, the direct-drive arm was used as a model. It was observed that in 
the case of the direct drive arm, the effects of the disturbance 1torquesecausc ise tae 
coupling inertia between links, and the centripetal, coriolis and gravitational forces on 
the robot arm, are larger. To overcome the disturbance torques, the servo motor has 
to applv larger torques. This requires a servo motor with high torque constant and 
high armature current capabilities. As an alternative solution to this, a gear train with 
a gear ratio of N mav be used. Thus the effects of the disturbance torques were 
reduced By N. Of course, the price of this alternative is a slower system. It ts up to 
the user to decide which is the best trade-off for a particular application. 

Simulation results show that steady-state accuracy of the order of 10E-4 was 
observed for the step position command input. This accuracy may not be enough for 
some applications. Therefore a further study area arises here to position the LINR2Z 
up more accurately. Some alternauve ways of doing this may be considered as; 


|. Replace the curve with a linear compensator and remove the tachometer 
feedback within the adaptive model. 


2. Replace the curve in the model with a gain block and modify the 
tachometer feedback gain. 


In the modelling of the arm, a rigid body was assumed. Another area for further 
study arises when a lightweight, flexible structure is used to build the robot arm. The 
effects of the mechanical resonance is due to the flexible structure on the adaptive 


system to be studied. 
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In this thesis delaved steps were used to prevent undesired motions. To use this 
technique effectively in a robot. the magnitude of such step. and the required delay 
time must be predetermined bv on-line calculation using some sort of algorithm which 


considers the initial oriantations of the arm, the commanded direction of the step, etc.. 
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APPENDIX A 
DSL PROGRAM FOR THE SECOND-ORDER MODEL SIMULATION 


TITLE DSL PROGRAM OF THE SIMULATION MODEL 
PARAM K1=0.60,K2=10000.,KM=4.0,VSAT=150.,K=1.0 
PARAM REF=1.0 
INITIAL | 

A-SQRT(2.*KM*VSAT) 

xDOT -0.0 
DYNAMIC 

R=REF*STEP (0.0) 

E=R-P 


IF PT o en S(E)) 
IF(E.GE.0.0)XDOT=A*K1*SQRT(E) 

DERIVATIVE 
XDOTE=XDOT-KPDOT 
KPDOT=PDOT*K 
V=LIMIT(-VSAT,VSAT,K2*ZDOTE) 
PDDOT=KM*V 
PDOT= INTGRL (O. 0,PDDOT) 
P=INTGRL(0.0,PDOT) 

TERMINAL 

METHOD RKSFX 

CONTRL FINTIM=0.15000,DELT=0.00005 

PRINT 0.01,P,PDOT,XDOT,V,XDOTE 


SAVE د‎ REF PD 
SAVE (G3)0.00005,P,REF 
GRAPH(G1/Gl , DE=TEK618,P0=1,.5) P(LE=6.5,UN='RAD' 2» 





XDOT(LE=8 ,NI=8,LO=0.,UN="RAD/SEC' ,SC=SAR), 
PDOT(LE=8 ,NI=8,LO=0.0 UNE" RAD/SEC!, P0=6.5,5C= SAR) 

GRAPH(G3/G3,DE=TEK618,PO=1,.5) TIME (LE=6.5, UN= "SECONDS! ), 
P(LE=8,NI=8,LO=0,UN='RAD' ,SC=0.25 
REF(LE=8,NI=8,LO=0 ,SC=0.25,AX=OMIT) ` 

LABEL (Gl) PHASE PLANE 

LABEL (Gl) XDOT,PDOT VS P 

LABEL (G3) STEP RESPONSE 

LABEL (G3) P VS TIME 

END 

STOP 
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APPENDIX B 


DERIVATION OF MATHEMATICAL MODEL FOR THE TWO- 
DEGREES-OF-FREEDOM PLANAR ROBOT ARM 


The Lagrangian, L = K — V of the system is: 


9 0 ° ١ 
L = Amp 0 | Hyd * Jay" (eqn B.1) 
aem (d; td + 204" é 
+ ma(d,”+ d,d>cos8,)6,0, 
= [(my + m>)d ¡ sin8 y + modosin(0, + 0-)]g 


Taking partial derivatives of Equation B.1 with respect to 9, and 05 : 


e 








T = — (m; Fny)gd;cos0; — m>gdycos(0; + 0>) (eqn B.2) 
l 

¿L : e . ہے‎ . 

20 = — (nbd;d>sinQ->)8, 7 — (mydyd>sin0>)0;0> (eqn BS) 
2 


— mgd>cos(0, + 0>) 


Taking partial derivatives of Equation B.l with respect to 0, and O, : 


ÓL 5 3 
r wm pups (eqn B.4) 
| + my(dy” + dy” + 2d,d>c086>)8, 


E 


W 


= (modo? W J~ )د‎ ETE as ۵٥۱ (eqn B.3) 


M 
<D 


2 


Taking derivatives of Equations B.4 and B.5 with respect to time: 


d GL 5 2 2 i „| 
M = (mjd)°+J 4) + mod) * + mod * 2m5dd5cos05)0, (eqn B.6) 
l ې‎ (mods? + m5d,d»5cos05)0» — (2m»d, d5sin05)0, 0» 


— (myd;d>sin8>)6>7 
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4 fàL . " 


Substitude Equations B.2 - B.7 into Equation 3.1, obtain: 


5 > ©. 

1j = Cm, tmp td tn يز‎ 
T m»(d5* * di d5cos0 )0» zę (2m5d,d5sin05)0 6^ 
= (mdyd>sin6>)6>7 0 (m; F m)gdycosb 


E m5gd »cos(8, * 05) 


T 7 (mydy^ *Jg385 + molda? + dj dcos65)8, 
m (mdj dasin0 8,0 ES (m5d ,dssin04 0 0, 


(eqn B.7) 


(eqn B.S) 


(eqn B.9) 


When we arrange the terms in Equations B.8 and B.9, we obtain Equation 3.1. 
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APPENDIN C 


BOLAROGRAM FOR VOLTAGE SOURCE DRIVE (NO 
GRAVITATIONAL TORQUES) 


TITLE SIMULATION PROGRAM OF THE ADAPTIVE MODEL (VOLTAGE SOURCE DRIVE) 

TITLE NO GRAVITATIONAL TORQUES 

PARAM K1=0.60,K2=10000. ,KMI=0.17,KM2=4.00,VSAT1=100.,K=1.0,T=0.00025 

BAREM G=336,4 MI=0.248,M2=0.082,KT1=14.4,KT2=14.4,D1=15.,D2=10. 

BOEN Jls0,033,J2=0.033,4V1=0.1012 KV2=0.1012,R1=0.91,R2=0.91,K3=0.6 

PARAM REF1=1.0,REF2=1.0,L=0.0001,BM1=0.0429,BM2=0.0429,VSAT2=50. 

INTGER N1,N2,FLAG1,FLAG2 

INITIAL 
N1=0 
FLAG1=0 
N2=0 
02-0 
PET 
P2=0.0 
PlDOT-0. 

P2DOT=0. 
P1DDT=0. 
P2DDT=0. 
PM1=0.0 
PM2=0.0 
PM1DT=0. 
PH2DT=0. 
۶211100-0 . 
PM2DDT=0. 
KIBOR=O. 
ZAROTO, 

۲910: 

IO, 

EO. 

TE22-0. 
PP1=L/R1 
PP2=L/R2 

ا 

20 

IH1=0. 

IM2=0. E 
کت‎ aus اص‎ 
AŻ=SÓRT(2.*KM2*VSAT2 

DERIVATIVE | 
BE 4ی‎ 
RRZ=REF2*STEP(0.0 
RRD2=TRANSP(50,0.0,0.10,RR2) 

E1=RR1-Pl 
E2=RRD2-P2 

NOSORT ١ ٢ ln. 
D11=(M1+M2)*(D1**2)+M2*(D2**2)+2*M2*D1*D2*COS(PM2) 
5 < +M2%D1*D2*COS (PM2) 

D222H2*(D2**2) 
D122=-M2*D1*D2*SIN(PM2) 
0 7+2 

000 1 

0 62 

0 1 

0521-2 

| 21117-2111 +2 | 

* G1l=(M1+H2)*G*D1*COS (PM1 )+M2*G*D2*COS (PMT) 

A G2=M2*G*D2*COS (PMT ) | | | 
TL1=D12*PM2DDT+D122*PM2DT**2+2*D112*PM1DT*PM2DT 
TL2=D12*PM1DDT-D211*PM1DT**2 
77018 71 


٠١١ 


JTOT2=J2+D22 

IF(E1l.LT.0.0)X1DOT=-A1*K1*SORT(A 
IF(EI.GE.OSO 1د‎ 1-231 1751 ٦٣ 
IF(E2.LT.0.0)X2DOT=-A2*K3*SQRT(A 
17۶26 0.0) 2200] 220 KI SORNE 


X1DOTE=X1DOT-KP1DOT 
KP1DOT=P1DOT*K | 
V1=LIMIT(-VSAT1,VSAT1,K2*X1DOTE) 


NOSORT 
îi Du ce EOS Go DO 5 
IF(V1.LT.VSAT1.AND.TIME.GT.0.00005)FLAG1=1 
NSW1=N1 

5 CONTINUE 


SORT 
P1DDT=KM1*V1 
P1DOT=INTGRL (0.0 ,P1DDT) 
P1=INTGRL(0.0,P1DOT) 
VP1=V1- (KULOPUIDT) 
IM1=REALPL(0.0,PP1,VP1/RL) 
TM1=KT1*IM1 
TNET1=TM1-PM1DT*BM1-TL1 
PMIDDT=(1./JTOT1) *TNET1 
PHIDT=INTGRL (0.0, PH1DDT) 
PHI=INTGRL (0.0, PHLDT) 
X2DOTE=X2DOT-KP2DOT 
KP2DOT=P2DOT*K | 
V2=LIMIT(-VSAT2,VSAT2,K2*X2DOTE) 


NOSORT 
EN EOL CGO TOG 
IF(V2.LT.VSAT2.AND.TIME.GT.0.00005)FLAG2=1 
NSW2=N2 

6 CONTINUE 


SORT 
P2DDT=KM2*V2 
P2DOT=INTGRL(0.0,P2DDT) 
P2=INTGRL(0.0,P2D0T) 
VP2=V2- (RV2"P 1207) 
IM2-REALPL(0.0,PP2,VP2/R2) 
TM2=KT2*IM2 
TNET2=TM2-PM2DT*BM2-TL2 
Pu DOr I Jo MET? 
PM2DT=INTGRL(0.0,PM2DDT) 
PM2=INTGRL(0.0,PM2DT) 

SAMPLE 

NOSORT 


S(E1)) 
S(E2)) 


~x W~ UJ 


SORT 


AS ‚EQ. AE: POT 
IF(Nl.EQ.0)GO TO 20 
P2=PM2 
P1=PMI 
A BZ nld 
KSI=ABS(2.*PM1/(V1*%((N1*T)**2 
IF(FLAG2.EQ. Ojee -KS2 
IF(FLAG1.EO.0)KM1=KS1 
IF KR e m OP 
IF(N1.GE.2)PMLDTL=(PM1-PM12L)/(2.%*T 
IF(FLAG2.EQ. 012007 BR S UR o. 
IF FLAGI. EQ. 0)P1D0T=(2.%( (PHL-PMILST)/T) )-PMIDTL 
IF(N2.EQ.NŚW2.AND.FLAG2.EQ.1)GO TO 21 
IF(N1.E NENI. AND.FLAG1.E0.1)G0 TO 20 
IE (FLAG E 11820027 )2.7 2--272 /T))-PM2DTL 
IF(FLAG1.EO.1)P1DOT=(2.* /T) ) -PMIDTL 
21 N2=N2+1 
20 N1=N1+1 

PM2DTL=P2DOT 

PMIDTL=PIDOT 

P2DOT=PM2DTL 

PM22L=PM2LST 

PM12L=PM1LST 


70 ٌ1ٰ ٤ 


PM2LST=PM2 
| 2111157-41 
* eem 
x ER2=ABS(RR2-PM2 
SORT 
TERMINAL 
FINISH PM1=1.00 
METHOD RKSFX 
CONTRL FINTIM=0.70000,DELT=0.00005,DELS=.00025 
PRINT 0.010,X1DOT,P1DOT,PM1DI,X2DOT,P2DOT,PM2DI,PM1,RR1,PM2,RR2,TM1,TM2 
SAVE EN 0.01, X1DOT,P1DOT,PM1DT,X2DOT,P2DOT,PM2DT,PM1 ,PM2 
SAVE (S3) 0.01, P1,PM1,REF1,P2,PM2,REF2,RR1,RRD2 
GRAPH (Ll/S1,DE=TEK618,PO=1,.5) PMi1(LE=6.0,UN='"RAD' ,LO=-0.10,SC=0.10, 
NI=12) PIDOT(LE=4,N1=4,LO=-2.0,UN='RAD/SEC',SC=2.0,PO=6. 0), 
5 ,NI=4,LÓ=-2.0,SC=2.0,UN='RAD/SEC' ,AX=OMIT), 
PMIDT (LE=4 ,NI=4, LO=-2.0,UN='RAD/SEC! ,SC=2.0 
GRAPH (L2/S1,DE=TEX618,0V,PO=1, 5) PM2(LE=6.0, UN='RAD' ,LO=-0.10, 
SC=0.10,NI=12), P2DOT(LE=4,NI=4,LO=0.0 ,UN='RAD/SEC!, SC=5.0, 
PO=6.),X2DOT(LE=4 ,NI=4 LO=0.0,UN='RAD/SEC' ,SC=5.0,AX=OMIT), 
PM2DT(LE=4 ,NI=4,LO=0.0,UN='RAD/SEC' ,SC=5.0 
GRAPH (L3/S3,DE-TEK618,PO-1,.5) TIME(LE=6.0, UNS! SECONDS | » 
P1(LE=4  NI=4 LO=-.5,UN='RAD' ,SC=0.50,PO=6.0),... 
Bl (Leś MI=ć Poz” .5,UN= Ran! sc=0.50), i 
RR1(LE=4,NI=4 LO=-.5,SC=0.50,AX=OMIT) 
ERAPE (14/53 DE=TEK618,P0=1,5,0V) TINE(LE=6.0,UN='SECONDS'), 
2(LE=4,NI=4,LO=-.5,UN='RAD',SC=0.50,P0=6.0),... 
لک‎ . 
| RRD2(LE=4 ,NI=4,LO=-.5,SC=0.50,AX=OMIT 
IRAPH(LS/83,DE-IEKó18,PO71,.5) TIME (LE=6.0 ¿UNS "SECONDS! ), 
* ER1(LI=8,NI=8,LO=0. ,UN='RAD' ,SC=0.005 
x ER2(LE=8, m 8 LO=0. UN=!'RAD! SC=0.005, PO=6. 


LABEL (L1) PHASE PLANE (VOLTAGE SOUR. DRV. WITH LOAD) 
IRSEL (03)05WEP RESPONSE(VOLTAGE SOUR. DRV. WITH LOAD) 
LABEL (L5) ERROR VS TIME (VOLTAGE SOUR. DRV. WITH LOAD) 
END 

STÓP 
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APT'EINDIN ٢ 


DSL PROGRAM FOR VOLTAGE SOURCE DRIVE (GRAVITATIONAL 
0 ١١" ۰۱ 


TITLE SIMULATION PROGRAM OF THE ADAPTIVE MODEL (VOLTAGE SOURCE DRIVE) 
TITLE GRAVITATIONAL TORQUES INCLUDED 

PARAM K1=0.60,K2=10000.,KM1=0.17,KM2=4.00,VSAT1=300.,K=1.0,T=0.00025 
PARAM G=386.4,M1=0.248,M2=0.082,KT1=14.4,KT2=14.4,D1=15.,D2=10. 

PARAM J1=0.033,J2=0.033 ,KVI=0 71012 KV2=0 1012 RIO 20 Ds 
PARAM REF1=1,0,REF2=1,0/7L-0.0001 ,BHl-0.0429 E-000425) Cs 
INTGER NI, N2 6 75 

INITIAL 


AN ZA 
A2=SÓRT(2.*KM2*VSAT2 
DERIVATIVE | 
EA 
RR2=REF2*STEP (0.0 
RRD2=TRANSP(50,0.0,0.10,RR2) 
El=RR1-P1 
E2=RRD2-P2 


D1l=(M1+M2)*(D1**2)+M2*(D2**2)+2*M2*D1*D2*COS(PM2) 
lL +M2*D1*D2*COS (PM2) 

D22-2M2*(D2**2) 

D122=-M2*D1*D2*SIN(PM2) 

09-7 

DI ٦ 

Ll 7 

6321001 

ت7 ق8 

PHT=PM1+PM2 | | 
G1=(M1+M2)*G*D1*COS(PM1)+M2*G*D2*COS(PMT) 
G2=M2*G*D2*COS (PHT) | | | 
TL1=D12*PM2DDT+D122*PM2DT**2+2*D112*PM1DT*PM2DT+G1 
TL2=D12*PM1DDT-D211*PM1DT**2+G2 

110112171711 


NOSORT 
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JIOT2=J2+D22 


IF(E1.LT.0.0)X1DOT=-A1*K1*SQRT(ABS(E1)) 
F(El.GE.0.0) X1DOI-Al^Kl^SORT(El) 
IF(E2.LT.0.0)X2DOT=-22*K3*SORT(ABS(E2)) 
Ir(Z2.GE.0.0)X2DOT=A2*K3*SQRT(E2) 
SORT 
X1DOTE=X1DOT-KP1DOT 
KPLDOT=P1D0T*X | 
V1=LIMIT(-VSAT1,VSAT1,K2*X1DOTE) 
NOSORT 
IF B .EQ.1)GO TO 5 
IF LT .VSATI .AND.TIME.GT.0.00005)FLAGI=1 
NSW1=N1 
5 CONTINUE 
SORT 


P1DDT=KM1*V1 
P1DOT=INTGRL(O.0,P1DDT) 
=INTGRL(0.0,P1DOT) 
JI: V1-(RV1*PMIDT) 
IM1=REALPL(0.0,PP1,VP1/R1) 
7 1 
11151121111 - 211180758111 -1 
210201-1-121 
PMIDI=INITGRL(0.0,PN1DDT) 
PHM1=INIGRL(0.0,PI1DT) 
X2DOTE-X2DOT-RP2DOT 
KP2DOT=P2DOT*K | 
V2sLTHIT(-VSAT2,VSAT2,K2^X2DOTE) 
NOSORT 
IE (FLAG2.E0.1)G0 TO 5 


OET 0 Alb, Salis .GT.0.00005 


NSW2= 27 
6 CONTINUE 


SORT 
P2DDT=KM2*V2 
P2DOT-INTGRL(0.0,P2DDT) 
P2=INTGRL (0.0, P2DOT) 
VP2=V2- (KV2*PH2DT) 
MESES T2L(O.0,222,VP2/R2) 
TM2=KT2*IM2 
ITNET2=TH2-PM2DIT*BM2-IL2 
BIZDDI=(1. (JTOT2)ZTNETZ 
PM2DI= INTGRL(O. , 211200 ( 
PH2=INIGRL (0.0, PH2DT) 

SAMPLE 


NOSORT 

a „EQ. آ0 کل‎ 

Bi ,20.0)GO TO 20 

P2=PH2 

P1 1=P>M1 

KS 他 een (va 7 

KS1=ABS(2.%*PM1/(V17%((N1*T)**2 

LE (ELA 2 AM2= 
. 1 
E a; 
: PH1-PM12L)/(2 


O > 
O 
aa 
"LE 
SA 
(n 
N 


. لل‎ ٠ 


PADOT=(2.7 


HHHHHHHH 
TPP rp ap ray ay ry ayy 
1 
ES 
ملم‎ 
Q 
N 
UI M — Z PI UI N MV N1 71° 


OO ui NO IO! 


"0۳05 Eos 
DOI 


ERE 
+1] 
o 
a 
Ha 


2:7 

21 N2= A) 

20 N1=N1+1 
PH2DTL=P2DOT 
PHIDTL-P1DOT 
P2DOT-2?2H2DIL 
PM22L=PM2LST 
۶141281-7 


ا ا ور مت ات 
Si‏ ۰۶ط 0 
GO TO 21‏ "۰ئ۰ و W2.AND.‏ 
RONDO TSSI.EQO.1)G0 TO 20‏ 
SL (Eric pas‏ 
Ai O EEPHILSIT‏ 


FLAG2=1 


00۲ 
NT 


me 
e 


PM2LST=PM2 
PMILST=PM1 

大 

大 ERZ=ABS (RR2-PH2 

SORT 

TERMINAL 

FINISH PM1=1.00 

METHOD RKSFX 

CONTRL FINTIM=0.70000,DELT=0.00005,DELS=.00025 

PRINT 0 . 010 , 151201 , 21201 , 281121 , 22801 , 222801 , 211221 , 2111 , 881 , 2112 , 882 , 7111 , 2 

SAVE Bl 0.01, XIDOT,Pl1DOT,PMIDT,X2DOT,P2DOT,PM2DT,PMl,PM2 

SAVE (53) 0.01, P1,PM1,REF1,P2,PU2,REF2,RR1,RRD2 

GRAPH (Ll/S1,DE=TEK618,PO=1,.5) PMI(LE=6.0,UN="RAD' ,LO=-0.10,SC=0.10, 

NI=12),P1IDOT(LE=4 NI=4,LO=-2.0,UN='RAD/SEC' ,SC=2.0,PO0=6.0), 
BIDOT(LE=4 Ni=á,LÓ= 2.0. 5C=2.0 UNS RAD/SEC. AX=OMIT), 
PMIDT(LE=4 NI=4 L0=-2.0 UN='RAD/SEC',SC=2.0 

GRAPH (12/81, DE=TEK618,0V,PO=1,5) PM2(LE=6.0,UN='RAD' ,LO=-0.10, 

SC=0.10,Ni=12), P2DOT(LE=4,NI=4, LO=0. 0,UN='"RAD/SEC' ,SC=5.0, 
PO=6.) X2DOT(LE=4,NI=4,Lo= 0. 0,UN='RAD/SEC' ,SC=5.0,AX=OMIT), 
PM2DT(LE=4 NI=4,L0=0.0 UN='RAD/SEC!,5SC=5.0 

GRAPH (L3/53, DE=TEK618,P0=1,.5) TIME(LE=6.0,UN='SECONDS'), 

P1(LE=4,NI=4,LO=-.5,UN='RAD',SC=0. 30, 2076.0), ... 
PHI (LE=4 =4 NI=4,LO=-.5,UN='RAD! ,SC=0.50),.. 
RR1(LE=4 ,NI=4,LO=-.5,SC=0.50,AX=OHIT) 

GRAPH (L4/S3,DE-1ER618,P0-1,3,0V) TIME(LE=6.0,UN='SECONDS'), 
P2(LE=4 NI=4 LO=-.5, UN='RAD',SC=0.50,P0=6.0),... 
PH2(LE=4,NI=4,LO=-.5,UN='RAD!,SC=0.50 
RRD2(LE=4 ,NI=4,LO=-.5,SC=0.50,AX=OMIT 

*RAPH(L5/53,DE= TEK618,P0=1,.5) TIME(LE=6.0 UNS" SECONDS' ), 

| ER1(LE=6,NI=8,LO=0. ,UN='RAD' ,SC=0.005 

A ER2(LE=8,NI=8,LO=0. ,UN='RAD' ,SC=0.005,PO=6.) 





LABEL (L1) PHASE PLANE (VOLTAGE SOUR. DRV. WITH LOAD) 
LABEL (L3) STEP RESPONSE(VOLTAGE SOUR. DRV. WITH LOAD) 
LABEL (L5) ERROR VS TIME (VOLTAGE SOUR. DRV. WITH LOAD) 
END 

S DP 
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11117 
DELLE 
PARAN 
PARAM 
دچ‎ ۰١ 
PARAM 


])1 E 


۰۱۷۶۰٣۰۱٠٦٣٦۷۱۳۰ FOR CURRENT SOURCE DRIVE (NO 


GRAVITATIONAL TORQUES) 


SIMULATION PROGRAM OF THE ADAPTIVE MODEL (CURRENT SOURCE DRIVE) 
NO GRAVITATIONAL TORQUES 
Ki=0.60,K2=10000. , KM1=0.17, KM2=4.00, VSAT=100. ,K=1.0,T=0.00025 
G=386.4,M1=0.248,M2=0.082,KT1=14.4,KT2=14.4,D1=15.,D2=10. 

۷۶۰۰٠۹ J2Z=0,0353 KVWISD.1012, KV2z=0.1012,R1=0.91,R2=0.91,483=0.6 
REP1=1.0,REF2=1.0,L=0.0001,58111=0.0429,B112=0.0429 


PARAM RS=0.1,VSATA1=100,KA1=150, VSATA2=50, KA2=75 
IE KR NI,N2,FLEGi ,FLAGZ 


INITIAL 


N1=0 
FLAG1=0 
N2=0 
FLAGZ=0 


PM2DDT=0. 
XIDO O. 
2 ٦ 
BELG" 
02 

TIEN SO. 
nea). 
KF=1./RS 
RTOT1=R1+RS 
RTOT2=R2+RS 
PP1=L/RTOT1 
PP2=L/RTOT2 
TM1=0. 
TM2=0. 
BENED. 
2 0 
BST 
A2-SÓRT 


2.7 
2.*KM2*VSAT 


| | 


DERIVATIVE 


NOSORT 


3.14*TIME 
3.14*TIME 


8٦٤71 
SRZĘEREFZ”SIN 


| | 


RRD1=TRANSP(50,0.0,0.15,RR1) 


ELZBRI-PI 
EZ=RR2-P2 


D11=(M1+M42)*(D1**2)+M2*(D2**2)+2*M2*D1*D2*COS(PM2) 
رت‎ a +M2%D1*D2*C0S(PM2) 

D22-M2*(D2**2) 

D122=-M2*D1*D2*SIN(PM2) 

DAI D22 

DEL 1آ‎ 

0 75 

D u 1آ‎ 

0 2 

PMT=PM1+PM2 


GIZHI*M2)^G^DI^COS(PM1l)-*M2^G^D2^COS(PMT) 


1٢ 


大 


GORT 


NOSORT 


5 
SORT 


NOSORT 


6 
SORI 


SAMPLE 
NOSORT 


G2=M2*G*D2*COS(PMT) 


TL1=D12*PM2DDT+D122*PM2DT**2+2*D112*PM1DT*PM2DT 
TL2=D12*PM1DDT-D211*PM1DT*+*2 
JTOT1=J1+D11 
JTOT2=J2+D22 m 
IF(E1.LT.0.0)X1DOT=-A1*K1*SQR S(E1)) 
IF(E1.GE.0.0)X1DOT=A1*K1*SORT 

R 

T 


) 
"7 


| 


IF(E2.LT.0.0)X2DOT=-A2*K3*SQ 
IF(E2.GE.0.0)3ZDGTĘSAZWN ٤۶٣ 


1015-1-27 
KPIDOT-PIDOT^K 
V1=LIMIT(-VSAT,VSAT,K2*X1DOTE) 


y, TO 5‏ ت 
IF(V1.LT.VSAT.AND.TIME.GT.0.00005)FLAG1=1‏ 
NSW1=N1‏ 


( 
E 
E 


NVR YP 


Y 
T 
( 


CON ٣ 


P1DDT=KM1*V1 
P1DOT=INTGRL(0.0,P1DDT) 
PIrSINTORI (O.O, PIDOT) 
VE1=KF*IMI*RS 

VAL=V1-VF1 
VM1=LIMIT(-VSATA1,VSATA1,VA1*KA1) 
VDIEVNISRYL"PRIBT 
IM1=REALPL(0.0,PP1,VD1/RTOT1) 
LIL KEL nun f 
TMETISIDEIOMIDIABSMISDPEI 
21011321011711 TIET] 
PMIDT=INTGRL (0.0, SM1DDT) 
PM1=INTGRL(0.0,PM1DT) 
X2DOTE=xX2DOT-KP2DOT 
KP2DOT=P2DOT*K 
V2-LIMIT(-VSAT,VSAT,K2*X2DOTE) 


ZE (ELAGZ.EQ 10 TO 6 
IF(V2.LT.VSAT.AND.TIME.GI.0.00005)ELAC2=] 
NSW2=N2 


CONTINUE 


P2DDT=KM2*V2 
P2DOT=INTGRL(0.0,P2DDT) 
P2=INTGRL(0.0,P2DOT) 
VF2=KF*IM2*RS 

VA2=V2-VF2 | 
VM2=LIMIT(-VSATA2,VSATA2,VA2*KA2) 
VD2=VM2-KV2*PM2DT 
IM2=REALPL(0.0,PP2,VD2/RTOT2) 
IM2=KT2*IM2 | 
INET2=TM2-PM2DT*BM2-TL2 
PM2DDT=(1./JTOT2)*TNET2 
PM2DT=INTGRL(0.0,PM2DDT) 
PM2=INTGRL(0.0,PM2DT) 


10 to zi 


IF(N1.EQ.0)GO TO 20 

P2=PM2 

P1=PM1 | | 

tL ٣ 
KS1=ABS(2.*PM1/(V1*((N1*T)**2 
IF(FLAG2.EQ.0)KM2=KS2 

IF (FLAG1.EQ.0)KM1=KS1 

IF Ael um ax aue 
IF(N1.GE.2)PM1DTL=(PM1-PM12L)/(2.*T 

IF ETRA ED NED e ر٣٦‎ 
IF(FLAGI.EQ.O)PIDOT= (2.2 ((PMISPIIES DD DE 
IF(N2.EQ.NSW2.AND.FLAG2.EQ.1)GO TO 21 
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15 m Lol E 1) 60 10 0 
IF(FLAGZ.EQ. 0 (2-3 1214-2131 ١ “PN2DEL 
15 SJ EO.) PIDOT=(2.2#( (PHI=PH1LST)/ = FUDD iE 
21 N2=N2+1 
20 N1=N1+1 

PRZDIL=PZDOT 

PNIDIL=PIDOT 

1 221221215 71 

PHIZL=PMILST 

2 8 2ط 





PMILST=PM1 
ہے‎ i 
ERZ=ABS (RR2-PM2 
SORT 
TERMINAL 


FINISH 06 
METHOD RKSFX 
CONIRL FINTIM=1.00000,DELT=0.00005,DELS=0.00025 
PRINT 0.020,X1DOT,PM1DT,P1DOT,X2DOT,P2DOT,PM2DT,PM1,RR1,TL1,PM2,RR2,TL2 
SAVE HH 0.001, X1DOT,P1DOT,PM1DT,X2DOT,P2DOT,PM2DT,PM1,PH2 
SAVE ($3) 0.001, P1,PM1,REF1,P2,PM2,REF2,ER1,ER2,RR1,RR2 
GRAPH (L1/S1,DE=TEK618,PO=1,.5) PMI(LE=6.0,UN='RAD',LO=-0.10,5C=0.1, 
NI=12) ,P1DOT(LE=4,NI=6,LO=-6.,UN='RAD/SEC', 5C=3.0,PO=6. 5-0), 
EE =6,SC=3.0,L0=-6. ,UN='RAD/SEC' ,AX=OMIT), 
PMIDT(LE=4 ,NI=6 ,LO=-6. ,UN='RAD/SEC' ,SC= 3.0 
GRAPH (L2/S1,DE-TEK618,PO-1,5,0V) PM2(LE=6.0,UN='RAD' ,LO=-0.1, 
SC=0.10,NI=12), P2DOT(LE=4,NI=4, Lo=-6.0,UN='RAD/SEC' ,SC=3.0, 
PO=6.0), X2DOT(LE=4,M1=4,LO=-6.0,UN='RAD/SEC',SC=3.0,AX=0MIT), 
PM2DT (LE=4, NI=4 ‚Loe 6.0,UN='RAD/SEC' ,SC=3.0) 
GRAPH (L3/S3,DE-TEX618, IE LE=6.0, UN SECONDS: » 
P1(LE=4,NI=3, 10- O. 0 UN='RAD!',SC=0.50, 0-6.0),. 2m 
rs =4,N1I=3,L0=0.0, UN='RAD',SC=0. 50 
RR1(LE=4,NI=3,LO=0.0,SC=0.50,AX=OMIT) 
GRAPH (14/53 DE=TEK618,PO=1,5,0V) TIME(LE=6.0,UN='SECONDS'), 
2(LE=4,NI=3, LO=0.0,UN='RAD' ,SC=0.5,PO= 26.0)... 
Pi LE=4,NI=3,LO=0.0,UN='RAD',SC=0.5), 
RR2(LE=4 ,NI=3,LO=0.0,SC=0.5,AX=OMIT) 
GRAPH (L5/S3,DE=TEK618,PO=1,.5) TIME(LE=6.0,UN= SECONDS !), 
ERI (LES Seyi = 10-0. UN SRAD SG=0.05 





ER2 (LE=8,NI=8,LO=0. ,UN="RAD', SC=0.05, PO=6. ) 
LABEL (L1) PHASE PLANE (CURRENT SOUR. DRV. WITH LOAD) 
IL (ES) SINES RESPONSE a SOUR] ORVe WITH a 
ERES (ES) ERRORS TINE (CURRENT SOUR. DRV. WITH LOAD 
END 
STOP 
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DSL PROGRAM FOR CURRENT SOURCE DRIVE (GRAVITATIONAL 


TITLE SIMULATION PROGRAM OF THE ADAPTIVE MODEL (CURRENT SOURCE DRIVE) 


APPENDIX F 


TORQUES INCLUDED) 


TITLE GRAVITATIONAL TORQUES INCLUDED 


PARAM K1=0.60,K2=10000. ,KM1=0.17,KM2=4.00,VSAT=300. ,K=1.0,T=0.00025 
=386.4,M1=0.248,M2=0.082,KT1=14.4,KT2=14.4,D1=15.,D2=10 
1=0.033,J2=0.033,KV1=0.1012,RV2=0. 1012 PrO 7117 ROLE 


PARAM G 
PARAM J 


"PARAM REF1=1.0,REF2=1.0,L=0.0001 ,BMI-0.OFSZZRBIE-OG ٥ 
PARAM RS=0.1,VSATA1=300,KA1=350,VSATA2=150,KA2=175 
+86 4۹۹) ص‎ ۶ 


INITIAL 


N1=0 
FLAG1=0 
N2=0 
BERG) 
P1=0.0 
9 
P1DOT=0. 
P2DOT=0. 
PIDDT=0. 
P2DDT=0. 
PH1=0 .0 
PM2=0 .0 
PMIDT=0. 
PM2DT=0. 
PMIDDT=0. 
PM2DDT=0. 
Sp SOS 
23007-071 
D. 
IPSO. 
1 O 

Tr o n. 
KF=1./RS 
RTOT1=R1+RS 
RTOT2=R2+RS 
PENE PROGI 
PP2=L/RTOT2 
TM1=0. 
TREO. 
IMO. 
IM2=0. 
ANI کرت‎ 
A2=SORT (2. *KM2*VSAT 


DERIVATIVE 


Sg کر رر‎ 
RR2=REF2*SIN(3.14*TIME 


* RRDISTRANSP(50,0.0,0.1T57RR1) 


NOSORT 


12 ۲ 
EŻZ=RRZĘPZ 


D11=(M1+M2)*(D1**2)+M2*(D2**2)+2*M2*D1*D2*C0S(PM2) 
D122M2*(D2^*2)-M2^*D1^*D2^COS (PM2) 
D22-2M2*(D2**2 

D122=-M2*D1*D2*SIN(PM2) 

D211=D122 

D112 ٦ 

1 ٦ 

62 2-7 NU 

022127 17 

PMT=PM1+PM2 ` | 
G1=(M1+M2)*G*D1*COS(PM1)+M2*G*D2*COS(PMT) 


150 


SORT 


NOSORT 


5 
SORT 


NOSORT 


6 
SORT 


SANPLE 
NOSORT 


C22 CD2 COS (PMT). = | | 

NOR ۷۶1۷ ٢٣٢٢ 2201 111ص‎ 27۳1 
EX ZED All SMID 2+G2 

JAROPPZILEFDII 

J30012-J2*D22 0 | 

Se koa) .0)X1DOT=-Al*K1 “SORT (ABS(E1) ) 

EN E O 0 NIDOT=AJSKI=SORT(EI) 

18 BZ TT 0.0 2 2DOI=-A2*K3*SORT(ABS(E2)) 

(2ط) 1200020270535051 )0 ۰0ب I‏ 


X1DOTE=X1DOT-KP1DOT 
KP1DOT=P1DOT*K 
VI=LIMIT(-VSAT,VSAT,K2*X1DOTE) 


TE (FLAG! .EQ.1)G0 TO 5 
IF(V1.LT.VSAT.AND.TIME .GT.0.00005)FLAG1=1 
NSW1=N1 


CONTINUE 


P1DDT=KM1*V1 
P1DOT=INTGRL(0.0,P1DDT) 
P1=INTGRL(0.0,P1DOT) 
175 115*111 RS 
VAl=V1-VF1 | 
MI=LIMIT(-VSATA1,VSATA1,VAL*KA1) 
VD1=VM1-KV1*PM1DT 
IM1=REALPL(0.0,PP1,VD1/RTOT1) 
IMI=KT1*IMI1 | 
TNET1=TH1-PH1DT*BM1-TL1 
PM1DDT=(1./JTOT1)*TNET1 
PMIDT=INIGRL(0.0,PM1DDT) 
PMI=INIGRL(0.0,PMIDT) 
X2DOTE=X2DOT-KP2DOT 
KP2DOT=P2DOT*K | 
V2=LIMIT(-VSAT,VSAT,K2*X2DOTE) 


TOSS‏ کھت 6ت 
EX LET VSAWNSND.TIME.GT.O.00005)FLAG2721‏ 
NSW2=N2‏ 


0 


P2DDT=KM2*V2 
P2DOT-INIGRL(0.0,P2DDT) 
P2=INTGRL(0.0,P2DOT) 
VF2=KF*IM2*RS 

VA2=V2-VF2 | 
VM2=LIMIT(-VSATA2,VSATA2,VA2*KA2) 
VD2=VM2-KV2*PM2DT 
IM2=REALPL(0.0,PP2,VD2/RTOT2) 
TM2=KT2*IM2 | 
INET2=TM2-PM2DT*BM2-TL2 
PM2DDT=(1./JTOT2)*TNET2 
PM2DT=INTGRL(0.0,PM2DDT) 
PH2-INTGRL(0.0,PH2DT) 


DE 80 "fou 77 

NEUE EO.-0)GO TO 20 

P2=PM2 

P1=PH1 | | | 

و سه SV‏ 

IEEE ES o SPL /(VL*((NLFT)**2 
BEOPDAG2.EO.0)KM2-KS2 

Pee EAGT EO .0)KMI=KS1 

BO a VA eru 

EE ENTPrE>(PHI-PMI2L)/(2.*T 

ZE Eua 1 
NIE ED PEIDOIS(2.^CCPMI-PMILST)/T))-PMIDTL 
PRRNZZEOONSNZ AND. FLAG2.EQ.1)GO TO 21 
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IF(N1.EQ.NSW1. AND FLAGI 9 1 -ك 1 د‎ 
122 ROR EDO (2. دمورد۔ رر ( کی ضا 12ا22‎ 
1۶ )٣٢۸ہ٥1٠.جپ‎ ٠. 1 (۲18007) 2 *٭,‎ )“+ 11 ٢ 
21 N2=N2+1 
20 Ni=N1+1 . . 

PH ۶ ۳ 

上 上] /) ٣ 

۲۲12 ٦ 

۳۶ و ۲ 

PM2LST=PM2 

2111 51-71 

ET 

ERZEĘABS(RRZĘFNŻ 
SORI 


TERMINAL 

*INISH  PM1=1.0 

METHOD RKSFX 

CONTRL  FINTIM=1.00000,DELT=0.00005,DELS=0.00025 

PRINT 0 . 020 , 21201 , 211121 , 211201 , 122201 , 22201 , 211221 , 2111 , 881 , 11-1 , 2112 , 582 ,2 
SAVE ($1) 0.001, X1DOT,P1DOT,PM1DT,X2D0T,P2DOT,PM2DT,PM1,PM2 





SAVE Cog MD 70 PMI EEE Pe, PH2 „KEES ۳ر‎ ER2, RRIMRRZ 

GRAPH (L1/S1, DE= -TEKÓ18, PO= SEO PMI(LE- Ou UN='RAD! LOE =O... 8 AE 3 
NI= 1258 P1DOT(LE=4, NI= 6 LO==6 ,UN="RAD/SEC", Seo, O. e 
BEDOT(TES4 عدتے جن ٦ں حر‎ =O. 
۶:۸00۲ ۴۲24,۱۱06 UN=" SEC Et 


GRAPH (L2/S1,DE-TEK618,PO-1,5,0V) PH2(L 0 
SC=0.10,NI=12), P2DOT(LE=4 ,NI=4,LO=-6.0,UN='RAD/SEC' ,SC=3.0 
PO=6.0), X2DOT(LE=4,NI=4 , LÓ=-6.0,UN='RAD/SEC' ,SC=z3. ,AX=OMIT),. 
PM2DT(LE=4 ,NI=4,LO=-6.0,UN='RAD/SEC' ,SCz3.0) 
GRAPH (L3/S3,DE=TEK518,PO=1,.5) TIME(LE=6.0,UN='SECONDS'), 
P1(LE=4,NI=3,LO=0.0,UN='RAD',SC=0.50,P0=6.0),... 
PM1 (LE=4 ,NI=3,LO=0.0,UN=!RAD! ,SC=0.50), 
RR1(LE=4 ,NI=3,LO=0.0,SC=0.50,AX=OMIT) 
GRAPH (L4/S3,DE=TEK618,PO=1,5,0V) TIME(LE=6.0,UN='SECONDS'), 
P2 (LE=4, ,NI-3, LO=0.0,UN='RAD',SC=0.5,P0=6.0),... 
PM2(LE=4,NI=3,LO=0.0,UN='RAD',SC=0.5),... 
RR2(LE= 4 ‚NI=3,L0=0.0,5C=0.5,AX=OMIT) 
GRAPH (L5/$3,DE=TEK618,PO=1,.5) TIME(LE=6.0,UN= SECONDS), 
ERI(LE=8,NI=8,L0=0.,UN='RAD',5C=0.05), 
ER2(LE=8,NI=8,LO=0. ,UN='RAD' ,SC=Q0.05,PO=6.) 


LE=6. , JS RAD „LO==0 ل٢‎ 


LABEL (L1) PHASE PLANE (CURRENT SOUR. DRV. WITH LOAD) 
LABEL (LS Ma RESPONSE 0 SOUR. DRV. WINE dn 
LABEL (L5) ERROR VS TIME (CURRENT SOUR. +۶ 10٦ 
END 

STOD 


GJ 
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